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ABSTRACT 

A  two-link  planar  robot  arm  is  considered  inside  a  planar  polygonal 
workspace.  The  configuration  space  of  the  arm  is  shown  to  have 
0(n3)  components.  Modeled  on  the  Leven-Sharir  algorithm,  a  con- 
nectivity graph  CG  is  constructed,  of  size  0(n3),  in  time  O (n3 log(/z)) . 
This  graph  can  be  used  to  solve  any  instance  of  the  motion-planning 
problem  for  the  arm. 
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1.    Introduction. 

This  paper  addresses  the  motion-planning  problem  for  a  2-link  robot  'arm'  in  a  planar 
workspace  with  polygonal  obstacles.  Our  intention  is  to  adapt  the  known  motion-planning 
algorithm  of  Leven  and  Sharir  [LS]  to  this  problem.  The  idea  is  quite  simple:  the  Leven- 
Sharir  algorithm  is  for  moving  an  oriented  line-segment  of  fixed  length  (humorously  called  a 
'ladder')  around  a  planar  'room'  amid  polygonal  obstacles.  We  observe  that  a  simple  two- 
link  robot  arm  can  be  viewed,  fairly  realistically,  as  having  an  anchored  shoulder,  to  which  is 
attached  an  extensible  upper  arm,  which  is  in  turn  attached  to  a  fixed-length  forearm.  The 
joint  connecting  these  two  links  we  call  the  elbow.  For  convenience  we  shall  assume  that  the 
upper  arm  can  vary  in  length  from  zero  to  infinity  --  or  at  least  be  sufficiently  long  to  reach 
any  part  of  the  room  (ignoring  obstacles).  We  shall  assume  that  both  joints  can  rotate 
through  360°;  in  a  concluding  section  we  shall  discuss  briefly  how  some  of  these  assumptions 
can  be  relaxed. 

1.1.   The  particular  robot  model  used  in  our  analysis. 

We  will  consider  a  two-link  robot  anchored  at  a  fixed  origin  O.  Its  telescopic  upper  arm 
is  modeled  by  a  straight-line  segment  OP  of  variable  length  which  is  free  to  rotate  around  the 
shoulder  O  Its  forearm  PQ  is  of  fixed  length  d  and  can  rotate  freely  about  the  elbow  P.  It  is 
of  course  assumed  that  the  origin  itself  is  located  inside  the  room  but  outside  any  obstacle. 

This  problem  formulation  is  analogous  to  that  of  [LS]  in  that  the  forearm  is  similar  to 
the  ladder.  However,  an  additional  constraint  is  introduced  as  the  upper  arm  OP  is  to  remain 
clear  of  the  obstacles.  A  simplifying  assumption  is  made  that  the  extent  of  the  upper  ar~i  is 
not  limited,  which  would  in  practice  mean  that  it  is  great  enough  to  allow  the  elbow  to  reach 
the  outside  room  walls.  The  Leven-Shanr  algorithm  is  modified  to  deal  with  what  we  call 
'virtual  walls,'  representing  constraints  imposed  by  the  requirement  that  the  upper  arm  is  not 
to  intersect  obstacles.  Before  describing  the  algorithm  we  analyze  the  structure  of  the  set  of 
allowable  motions  of  the  robot  arm.  Our  analysis  largely  parallels  that  in  [LSJ  with  some 
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modifications  to  accommodate    virtual  walls.' 

2.    Analysis. 

Define  the  forearm  PQ  to  be  an  oriented  segment  of  length  d2,  with  elbow  P.  A  place- 
ment of  the  arm  is  a  pair  Z  =  (X,Q),  where  X  is  the  position  of  P  and  8  is  the  orientation  of 
PQ.  The  free  room  V  is  the  open  polygonaLy  bounded  region  given  by  room  interior  less  the 
obstacles.  A  real  wall  is  a  boundary  segment  of  V.  The  workspace  F  is  the  largest  open  star- 
shaped  region  with  center  at  O  contained  in  V.  F  is  clearly  polygonally  bounded  and  is  cut 
out  of  V  by  segments  each  originating  at  an  obstacle  corner  and  directed  away  from  O.  We 
refer  to  these  segments  as  virtual  walls;  from  now  on  'wall'  will  mean  a  real  or  virtual  wall. 
Clearly,  P  must  stay  within  F  since  the  line-segment  OP  (the  upper  arm)  must  stay  within  V. 

Definition.  The  set  of  free  placements  FP  (respectively,  semi-free  placements  SFP)  is  the 
set  of  all  placements  of  the  robot  arm  suh  that  both  OP  and  PQ  are  completely  contained  in 
V  (respectively,  in  the  closure  of  V). 

Note.  We  shall  assume  that  SFP  is  the  closure  of  FP,  which  means  that  SFP  cannot 
include  placements  in  which  the  arm  touches  obstacles  without  penetrating  them  but  any 
small  movement  of  the  arm  makes  it  penetrate  obstacles.  This  simplifying  assumption  can  be 
made  if  we  require  the  obstacles  to  be  'in  general  position'  in  the  sense  that,  if  such  place- 
ments exist  in  SFP,  then  they  can  be  removed  by  an  arbitrarily  small  perturbation  of  the 
positions  of  the  obstacles. 

2.1.    Purely  translations!  motion. 

For  the  purposes  of  this  section,  let  6  be  a  fixed  orientation,  which  we  shall  visualize  as 
being  directed  vertically  upwards. 


:  We  will  loosely  fellow  the  notation  of  [LS]  with  forearm  replacing  ladder  as  appropriate. 


Definition.  Given  a  placement  Z  =  (X,Q)£FP,  let  the  range  at  Z  (or  range  at  X  with 
respect  to  orientation  0)  I  (Z) ,  be  the  maximal  open  vertical  segment  through  X  traced  out  by 
P  as  the  forearm  moves  in  FP  along  a  vertical  line  through  X.  In  other  words,  it  is  the  set  of 
all  elbow  positions  in  placements  reachable  from  Z  by  a  vertical  motion  of  the  forearm.  The 
clearance  segment  J  (Z)  at  Z  is  the  set  of  points  swept  out  by  the  forearm  as  P  varies  over  the 
range  at  Z,  i.e.,  J (Z)  is  I (Z)  extended  upwards  by  a  segment  of  length  d. 

Definition.  The  upper  stop  of  Z  =  (X,8)  (or  the  upper  stop  of  X  with  respect  to  an 
orientation  9)  is  the  real  wall  which  Q  touches  or  the  virtual  wall  which  P  touches  when  P  is 
at  the  upper  end  of  /(Z);  similarly  the  lower  stop  is  the  real  or  virtual  wall  which  P  touches 
when  it  is  at  the  lower  end  of  I (Z)  (see  Figure  1).  If  the  upper  end  of  J  (Z)  is  at  a  corner  of 
the  free  room  V,  or  its  lower  end  is  at  a  corner  of  the  workspace  F,  the  stop  consists  of  the 
pair  of  walls  defining  that  corner.  In  the  c  se  where  at  the  upper  end  of  /(Z)  both  Q  touches 
a  real  wall  and  P  touches  a  virtual  one,  t  e  pair  of  these  walls  is  considered  to  be  the  upper 
stop. 

Since  all  lines  containing  virtual  walls  ntersect  at  the  origin,  at  most  one  virtual  wall  can 
delimit  the  upper  (respectively,  lower)  end  of  l(Z),  so  at  most  one  virtual  wall  can  partici- 
pate in  the  upper  (respectively,  lower)  stop.  Henceforth  a  corner  of  the  room  V  will  be 
called  a  real  corner,  and  any  other  corner  of  F  a  virtual  corner  (such  a  corner  is  at  the  inter- 
section of  a  real  wall  and  a  virtual  wall). 


J(X,Q) 


Figure  I. 
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Definition.    The  label  L  (Z)  of  Z  =  (X,  6)  €  FP  is  defined  to  be 
L(Z)  =  (lower  stop  (Z),  upper  stop{Z)). 
Note   that   all   points   on   /(X,9)    share    the   same   label   (with    respect   to    6).     A    placement 
Z=(X,8)  €  FP  is  generic  if  fcor/i  the  upper  and  the  lower  stops  of  Z  are  defined  by  exactly 
one  wall. 

Lemma  2.1.  Given  a  generic  placement  Z=(X,6),  there  is  an  open  neighborhood 
UCR2  of  X  on  which  £  is  constant,  i.e.,  (VX'iU)  I(X',8)  =  L(Z).  Note  that  implicitly 
Z€/7>.  so  |/(Z)|></. 

The  simple  proof  is  omitted:  the  result  holds  because  a  generic  placement  is  one  which 
does  not  change  its  label  with  a  sufficiently  small  horizontal  motion,  while  a  small  vertical 
motion  does  not  change  the  label  of  any  free  placement  by  the  above  observation. 

Definition.  Let  Z  =  (X,Q)£FP  be  generic.  The  (maximal  noncntical)  region  of  Z,  denoted 
R(Z),  is  the  connected  component  of  the  set 

{  X'    |  (X',9)  €  FP  &  L(X',6)  =  L(X,Q)  } 
containing  X. 

Clearly,  a  cross  section  of  such  a  region  by  a  line  with  orientation  6  through  point  X'  is 
just  /(X',8),  while  the  left  and  right  limits  of  the  region  are  determined  by  non-generic  place- 
ments or  by  reaching  the  boundary  of  FP.  Moreover,  a  maximal  noncritical  region  is  triangu- 
lar or  trapezoidal  in  shape  and  in  particular  is  (the  interior  of)  a  convex  polygon  (for  an 
example,  see  Figure  2).  The  placements  that  define  the  left  and  right  boundaries  of  a  maxi- 
mal noncritical  region  are  either  non-generic  or  non-free,  with  the  following  cases  possible 
for  such  placements  Z: 

(a)  the  upperflower  end  of  J(Z)  is  at  a  real  corner  or  its  lower  end  is  at  a  virtual  corner, 

(b)  the  length  of  the  clearance  segment  J(Z)  is  exactly  d, 

(c)  a  corner  comes  to  touch  the  interior  of  J(Z),  at  which  point  /(Z)  in  general  splits  into 
two  pieces,  or 
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Figure  2. 

(d)     a  virtual  wall  that  intersects  7(Z)  and  defines  the  upper  endpoint  of  the  range  /(Z)  at  Z 
comes  to  be  at  a  distance  of  exactly  d  from  a  real  wall  directly  above  it. 

Case  (d)  differs  from  (a)  in  that  there  need  not  be  actual  intersection  of  the  virtual  and 
the  real  walls  that  define  the  upper  stop  for  Z,  but  the  two  nevertheless  determine  a  stop.  In 
cases  (a)  and  (d)  the  placement  Z  is  non-generic,  in  case  (b)  it  is  in  the  boundary  of  FP,  and 
in  case  (c)  both  are  possible.  Figure  3  illustrates  the  possible  placements  that  give  rise  to  a 
region  boundary  condition.  The  vertical  line  segment  shows  J(Z)  in  cases  (a)  (excepting  the 
last  subcase)  and  (d).  In  (b)  and  (c),  it  indicates  the  limit  of  J  (Z)  as  the  forearm  approaches 
the  region  boundary  from  inside  the  region  R,  which  is  on  the  right.  Other  solid  lines  show 
real  walls,  while  dashed  lines  indicate  wrtual  walls  and  dot-dashed  lines  indicate  lines  traced 
by  P  as  Q  follows  a  real  wall.    Interiors  of  obstacles  and  of  the  region  R  are  shaded. 

Definition.  The  left  (right)  stop  of  a  region  R  is  defined  to  be  the  set  of  walls  that  cause 
one  of  the  conditions  (a)-(d)  to  become  true  at  the  left  (respectively  right)  boundary  of  the 
region. 

One  can  classify  the  cases  of  Figure  3  as  follows.  Let  /  be  the  line  through  X  with 
orientation  0,  where  X  is  a  point  on  the  left  (right)  boundary  of  the  region.  Then  (a),  (c), 
and  the  last  case  of  (b)  involve  /  passing  through  a  real  or  a  virtual  corner,  and  the  two  walls 
meeting  at  the  corner  define   the  (left)   stop,  while   (b)   (excepting  the  last  case)   and  (d) 
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Figure  3(a).  One  end  determined  by  a  corner. 
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Figure  3(b).  \J(Z)\  =  d,  in  the  last  subcase- virtual  upper  and  real  lower  stop.  See  also  last  subcase  of  3(a). 

>d 


Figure  3(c).  A  corner  meeting  the  interior  of  7(Z). 


Figure  3(d).  Interaction  of  an  upper  real  and  an  upper  virtual  stop, 
involve  /  intersecting  two  walls  at  points  exactly  d  apart,  and  these  two  walls  define  the  left 
stop  in  these  cases. 

Definition.  The  label  of  a  region  R  is  the  quadruple  consisting  of  its  upper,  lower,  left, 
and  right  stops.  The  following  lemma  is  an  easy  consequence  of  the  case-analysis  illustrated 
in  Figure  3.    (In  part  (b)  of  the  lemma,  perturbation  arguments  can  be  used  to  show  that  a 


free  placement  not  in  any  (open)  maximal  noncritical  region  is  in  the  closure  of  some  such 
region.  This  can  be  false  if  the  obstacles  are  not  in  general  position.) 

Lemma  2.2.  For  any  fixed  orientation  6,  (a)  each  (maximal  noncritical)  region  R  is 
characterized  uniquely  by  its  label,  and  consequently  there  are  only  finitely  many  such 
regions;  (b)  every  (semifree)  placement  is  in  the  closure  of  some  maximal  noncritical  region. 
a 

For  any  fixed  orientation  6  we  can  estimate  the  number  of  maximal  noncritical  regions 
by  bounding  the  number  of  times  conditions  (a)-(d)  can  arise: 

(a)  This  can  arise  no  more  than  0(n)  times -a  given  corner  can  be  an  endpoint  of  at  most  2 
segments  with  orientation  6.  There  are  n  real  corners  and  O(n)  virtual  ones. 

(b)  The  last  subcase  of  (b)  can  occur  as  many  times  as  there  are  virtual  corners,  or  O(n) 
times.  As  for  the  other  subcases,  observe  that  for  each  pair  of  walls,  for  a  given  orien- 
tation there  is  at  most  one  semifree  placement  where  the  forearm  touches  both  of  the 
walls.  Clearly,  such  boundary  conditions  will  occur  at  most  0(n:)  times.  Figure  4 
shows  that  fi(n:)  occurrences  are  possible,  su  this  bound  is  tight. 
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Figure  4. 
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(c)  Note  that  this  can  only  happen  at  a  convex  corner,  while  the  intersection  of  a  real  wall 
with  a  virtual  wall  always  creates  a  reflex  corner.  Therefore  (c)  occurs  only  at  convex 
real  corners.  However,  the  sets  /(Z)  for  different  regions  can  overlap  So  the  ques- 
tion is:  how  many  J  (Z)'s  can  there  be  that  pass  through  the  same  corner?  Answer: 
0(n),  for  each  has  to  have  an  intersection  of  /  with  a  wall  as  its  lower  end  and  no  two 
can  share  a  lower  end.  Since  a  line  of  fixed  orientation  through  a  fixed  corner  can  have 
at  most  O(n)  intersections  with  walls,  (c)  can  occur  only  O(n)  times  per  corner,  for  a 
total  of  0(n2)  times.    Figure  5  shows  that  this  bound  is  tight. 

(d)  Similar  to  (b).  For  each  pair  of  walls,  where  one  is  virtual  and  one  is  real,  there  is  at 
most  one  semifree  placement  (at  orientation  9)  where  P  is  on  the  virtual  wall  and  Q  is 
on  the  the  real  one.  Hence  (d)  occurs  0(n2)  times  and  again  this  bound  >  tight  (Figure 
4). 

Definition.    The  free  boundary  of  a  region  R  =R(X,Q)  is 
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Figure  5. 
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b(R)  =  {XZd(R)  \(X',9)£FP  \, 
where  d(R)  is  the  topological  boundary  of  R  as  a  planar  set. 

Lemma  2.3.    b(R)  consists  of  finitely  many  open  vertical  segments. 

Proof.  It  is  clear  that  b(R)  is  a  finite  collection  of  relatively  open  subsets  of  a  trapezoid 
boundary,  for  it  is  the  intersection  of  a  trapezoid  boundary  d(R)  and  an  open  polygonally 
bounded  region  {X'  \  (X'  ,Q)£FP  }.  Moreover  from  the  definition  of  upper  and  lower  stops  it 
is  clear  that  no  point  interior  to  the  non-vertical  part  of  the  boundary  of  R  can  be  in  b(R). 
Since  the  intersection  of  the  boundary  of  R  with  the  complement  of  FP  is  closed,  the  cornets 
of  R  are  not  in  FP  either.  □ 

Lemma  2.4.  Let  R  and  R'  be  distinct  (maximal  noncritical)  regions.  If  b(R)  and  b(R') 
have  a  point  X  in  common,  then  the  connected  components  of  b(R)  and  b(R')  containing  X 
are  identical  and  equal  to  /  =/(X,  6). 

Proof.  Let  L  be  the  component  of  b(R)  containing  X.  By  definition,  LCI.  Suppose 
that  L*  /;  /  must  contain  at  least  one  end  point  Y  of  L.  Since  the  d(R)  is  closed,  it  contains  Y, 
and  therefore  Y  is  in  d(R)t~\FP;  it  follows  that  Y  is  in  L,  a  contradiction:  therefore  I  =  L.  Simi- 
larly, /  is  the  component  of  b(R')  containing  X.    □ 

Lemma  2.5.  Let  R  and  R '  be  distinct  maximal  noncritical  regions.  Let  X£R  and 
X'iR'.  Then  b(R)Db(R')  *0  if  ind  only  if  there  exists  a  continuous  orientation-preserving 
motion  of  the  forearm  from  (X,Q)  to  (X'  ,Q)  that  does  not  enter  a  third  region. 

Proof.  It  is  a  straightforward  exercise  to  verify  that  if  R  and  R'  are  distinct  and  their 
free  boundaries  intersect  then  either  the  left  free  boundary  of  R'  meets  the  right  free  boun- 
dary of  R  or  vice-versa:  suppose  that  Y  is  a  point  in  this  intersection.  Clearly  there  is  a  trans- 
lational  motion  from  (X,8)  to  (K,6)  and  thence  to  (X' ,6),  where  all  placements  are  in  the 
union  of  the  closures  of  R  and  /?',  and  since  these  closures  plainly  cannot  intersect  a  third 
region  (regions  are  by  definition  open)  the  'if  part'  is  proved. 
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To  prove  the  converse,  we  need  to  show  that  if  such  a  motion  exists  then  it  must  be 
confined  :o  the  union  of  the  closures  of  R  and  /?'.  The  set  of  points  X  in  FP  (or  rather, 
points  X  such  that  vertical  placements  with  P  located  at  X  are  in  FP)  not  interior  to  a  third 
region  is  comprised  of  the  union  of  the  closures  of  R  and  R'  together  with  the  union  of  all 
free  boundary  components  disjoint  from  this  closure.  However,  by  Lemmas  2.3  and  2.4  the 
latter  union  consists  of  open  vertical  line-segments  whose  closures  are  all  disjoint  from  the 
closures  (in  FP)  of  R  and  R' ,  and  clearly  they  cannot  be  reached  from  R  or  R'  by  an 
orientation-preserving  path  in  FP  not  going  through  any  other  region,    c 

Definition.  The  connectivity  graph  for  a  fixed  orientation  6,  CGe,,  is  an  undirected 
graph  with  maximal  noncntical  regions  as  vertices  and  edges  defined  as  follows:  {/?,,/?;>}  is  an 
edge  of  CG$  if  and  only  if  b{R{)C\b(R:)±® . 

Lemma  2.6.  A  generic  placement  (X',9)  is  reachable  from  a  generic  placement  (X,9) 
by  a  continuous  orientation-preserving  (i.e.,  translational)  motion  if  and  only  if  R'  =R(X' ,9) 
is  reachable  from  R  =  R  (X,  6)  in  CG* 

Proof.    (1)  <=  An  immediate  consequence  of  Lemma  2.5 

(2)  =>  Let  it  be  a  suitable  path  and  suppose  without  loss  of  generality  that  R*  R' .  Assume 
that  R  and  R'  are  in  different  components  of  the  connectivity  graph:  we  shall  argue  a  contrad- 
iction. Suppose  C  is  the  component  of  R,  i.e.,  the  set  of  all  nodes  in  CG«  reachable  from  R 
in  the  graph.  Let  (r\6)  be  the  first  point  on  the  translational  path  it  such  that  Y  is  in  the  clo- 
sure of  some  region  R"  not  in  C:  such  a  point  exists  since  the  set  of  path  points  in  R"  is 
closed.  However,  Y  is  also  on  the  free  boundary  of  some  reg  on  U  belonging  to  C,  and  R"  is 
adjacent  to  U,  (by  the  above  lemma),  so  U  is  in  C,  a  contradiction,  c 

2.2.    Unrestricted  motion  of  the  robot  arm. 

In  this  section  we  shall  consider  general  (not  just  translational)  motions  of  the  arm,  and 
investigate  the  dependence  of  CGA  on  9. 
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Definition.  An  orientation  6  is  critical  (or  a  criticality)  if  there  is  a  region  fl(X,9)  the 
label  of  whose  left  (or  right)  stop  is  ambiguous  in  the  sense  that  two  independent  events  of 
the  type  described  in  Figure  3  occur  simultaneously  at  the  left  (or  right)  stop  of  R  (X,Q).  We 
shall  label  9  by  the  two  events.  R(X,Q)  is  thereafter  referred  to  as  a  witness  region  (or  sim- 
ply a  witness)  of  the  criticality  9. 

We  refer  to  the  number  of  witnesses  as  the  complexity  of  the  critical  orientation  9. 
Usually  a  criticality  has  more  than  one  witness,  since  it  arises  from  the  interaction  of  several 
regions;  as  we  shall  see  later,  the  complexity  of  a  given  critical  orientation  9  can  be 
unbounded  (i.e.,  il(n))  in  number,  and  one  cannot  rule  this  out  by  assumptions  of  general 
position,  as  one  could  in  the  'ladder'  problem.  The  criticalities  will  be  classified  below.  We 
shall  see  that  they  arise  from  coincidences  such  as,  for  instance,  the  orientation  being  parallel 
to  a  line  joining  two  corners;  under  assumptions  of  general  position  exactly  two  corners 
should  determine  such  a  criticality.  Criticalities  of  high  complexity  can  arise  because  there 
may  be  several  overlapping  segments  of  the  form  /(X,9).  U  this  happens,  all  these  segments 
are  contained  in  the  same  open  line-segment  in  the  room  V  (ignoring  the  visibility  con- 
straint), and  we  conclude  that  they  can  only  be  split  up  by  virtue  of  virtual  walls  crossing  this 
open  line-segment.  This  can  give  rise  to  il(n)  witnesses  (worst  case).  As  we  will  see  later, 
there  are  0(nz)  critical  orientations  of  complexity  O(n)  and  0(nl)  of  complexity  0(1). 

Note.  There  are  some  necessary  cond.tions  we  can  establish  for  a  region  R  to  be  a  wit- 
ness to  the  criticality  of  an  orientation  6.  These  are  somewhat  more  elaborate  than  those  for 
the  'ladder  problem'  given  in  [LS|.  Supposing  without  loss  of  generality  that  9  arises  from  an 
ambiguity  in  the  left  stop  of  R,  let  e  be  the  open  left  boundary  segment  of  R,  let  W  be 
obtained  by  extending  R  upwards  by  a  vertical  distance  d  (adding  a  parallelogram  to  the  top 
of  R),  and  let  e'  be  the  open  left  boundary  segment  of  W:  it  is  just  e  extended  upwards  by  a 
segment  of  length  d.  Clearly  W  is  in  V:  its  upper  boundary  is  defined  by  the  upper  stop  of  R. 
Both  e  and  e'  may  meet  the  boundary  of  the  workspace  F.    By  definition,  R  cannot  intersect 
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any  real  or  virtual  walls,  and  W  cannot  intersect  any  real  walls:  but  the  parallelogram  by 
which  it  extends  R  may  intersect  some  virtual  walls.  Therefore  e  cannot  penetrate  any  real  or 
virtual  walls  and  e'  cannot  penetrate  any  real  walls  and  can  cross  virtual  walls  only  in  its  top- 
most segment  of  length  d. 

Lemma  2.7.  Suppose  R  is  a  maximal  noncritical  region  at  an  orientation  0,  where  R  is 
not  a  witness  region  (whether  or  not  6  is  critical).  Then  there  exists  an  open  interval  con- 
taining 9  such  that  for  each  9'  in  this  interval  there  is  a  unique  region  R$  whose  label  coin- 
odes  with  that  of  R.  Moreover,  R 9  varies  continuously  (in  a  sense  which  can  easily  be  made 
precise3)  with  9'  as  9'  varies  over  this  interval.  There  is  a  maximal  interval  (0i,9:)  with  this 
property,  and  both  orientations  9,  are  critical  and  distinct,    n 

This  can  be  proven  by  a  straightforward  case  analysis  which  the  interested  reader  is 
invited  to  complete. 

Definition.    Let  R,  0  be  as  above.  Define  a  cell  to  be 

C  =  {(X',e')  |  X'tRi   and  9'€(9,,9:)  }, 
where  (9,,9:)  is  the  maximal  open  interval  around  9  as  in  Lemma  2.7.    We  shall  call  9,  and 

9:  respectively  the  lower  and  upper  ^-bounds  of  C.    The  open  interval  (6j , 02)  will  also  be 

called  the    range  of  C .    A  cell  defined  in  terms  of  R  (Z)  will  be  denoted  C  (Z)  (and  called  'the 

cell  containing  Z'). 

Lemma  2.8.    Every  such  cell  C  is  open. 

Proof.  Consider  a  placement  Z  =  (X,  0)  in  C,  where  R  (Z)  is  not  a  witness  to  the  critical- 
iry  of  9,  and  let  e  be  the  distance  from  X  to  the  boundary  of  R(Z).  By  Lemma  2.7  the  boun- 
dary segments  of  #,  vary  continuously  with  9'.  Thus  there  exists  8>0  such  that  for  all  0',  if 
|0'-0|<6,  then  the  ball  Bt  :(X)  of  radius  e/2  centered  at  X  contains  no  points  of  the  boun- 
dary     of      Re.        In       other      words,      Bt  2(x)       >s      entirely       in      R*  .        Therefore, 


'For  instance,  the  boundary  of  the  regions  vanes  continuously  with  respect  to  the  Hausdorff  metric. 
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fle:(X)x(e-8,9-5)CC(Z).  D 

Lemma  2.9.  Given  two  placements  Z  and  Z'  in  the  same  cell  C,  there  exists  a  motion 
connecting  them  in  C,  and  such  motions  can  be  defined  in  a  canonical  way.  In  particular, 
every  cell  C  is  path-connected. 

Proof.  (Sketch).  By  definition,  the  cross-section  RB  of  C  at  any  orientation  0  within  its 
range  is  path-connected,  so  it  is  enough  to  identify  a  canonical  motion  between  canonical 
placements  Ze  in  the  regions  R$  (technically,  in  R*  x  {6}).  Following  [LS]  we  choose  Ze  as 
the  'centroid'  of  R*  —  that  placement  where  P  is  the  midpoint  of  the  line  connecting  the  mid- 
points of  the  upper  and  lower  boundary  segments  of  R$.    □ 

Definition.  The  free  boundary  of  a  cell  C  is  the  (topological)  boundary  of  the  cell  in  FP, 
i.e.,  b(C)  =  d(C)r\FP.    Let  C  =  {  (X,6)  |  XZRB,  0€(9,,9:)}  be  a  cell.    Define 

<£>,(C)   =    lim  closure(R$), 

6-8  f 

<f>-,(C)  =    lim  closure(Rs), 

e-ef 

Also  let 

bQ(C)  =  {  (X,0)   |X€fc(*e).  e€(9,,92)}, 
bx(C)  =  interior  (#,(C))x  {9,}, 
b2(C)  =  interior  (<t>;(C)) x{9;}. 

Lemma  2.10.  <t>i(C)  (<t>:(C))  is  a  point,  a  line  segment,  a  trapezoid,  or  a  triangle. 
Moreover,  in  the  latter  two  cases,  interior (<t> |(C))  (respectively,  interior  (<t>;(C)))  is  either  a 
maximum  noncritical  region  with  respect  to  9,  (respectively  9:)  or  two  such  regions  with 
identical  upper  and  lower  stops  together  with  the  free  boundary  segment  between  them. 

Proof.  (Sketch).  Without  loss  of  generality  we  consider  only  ^(C).  The  first  part  of 
the  lemma  is  clear,  as  <I> ,  (C )  is  a  limit  of  a  continuous  family  of  trapezoids  or  triangles  and 
therefore  a  possibly  degenerate  trapezoid.  Let  R  denote  the  interior  of  ^(C).  If  R  is 
nonempty  then  we  must  argue  that  it  is  either  a  maximal  noncritical  region  or  the  union  of 
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two  such  regions  together  with  their  separating  free  boundary.  Let  w,  (i  =  l,  2)  be  the  upper 
and  lower  stops,  respectively,  associated  with  C.  By  continuity  arguments  it  is  clear  that  both 
these  walls  (whether  real  or  virtual)  define  upper  and  lower  stops  for  all  placements  in  R, 
and  RCFP  (i.e.,  R  X  (9JCFP).  An  inspection  of  Figure  3  will  show  that  all  the  conditions 
defining  left  (and  rfght)  stop  for  the  translational  regions  R^  will  also  hold  in  the  limit  as 
6  — 9 , .  Thus,  if  all  placements  (X,9,)  with  X  in  R  have  wl,w2  only  as  upper  and  lower  stops, 
R  is  clearly  a  maximal  noncritical  region.  Otherwise,  let  X  be  a  placement  in  R  which  has 
some  other  wall  in  its  upper  (lower)  stop  besides  w]  (w2).  A  simple  case-analysis  based  on 
Figure  3  will  show  that  the  only  possibility  is  as  illustrated  in  Figure  6:  the  line  at  orientation 
6[  through  x  passes  through  the  upper  stop  —  which  must  be  a  virtual  wall  —  and  meets  an 
obstacle  point  at  distance  d  beyond  this  point  of  intersection.  This  introduces  a  line  of  orien- 
tation 6,  which  splits  R  into  two.  By  continuity  arguments,  if  we  assume  that  no  two  walls  are 
parallel,  the  given  obstacle  point  must  be  a  real  wall-corner.  By  assumptions  of  general  posi- 
tion such  a  splitting  line  cannot  occur  twice  for  the  same  orientation  9^  and  it  clearly  intro- 
duces left  and  right  stops  for  two  regions  whose  union  forms  R  (see  the  note  below  for  a  cla- 
rification).   This  concludes  the  argument.    D 


9>9, 


9  =  9 


<t>  ,<C)  =  R  UR,Ue 


Figure  6. 
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Note.  For  each  real  corner  p,  there  are  0{n)  orientations  0,  such  that  the  line  at  orien- 
tation 0,  through  p  meets  a  virtual  wall  at  distance  d.  By  an  arbitrarily  small  perturbation  of 
the  obstacle  corners  if  necessary,  we  can  ensure  th  for  any  two  different  corners  these  sets 
of  orientations  do  not  intersect.  Hence  it  is  legitimate  to  assume  that  the  cell  R  is  split  by  at 
most  one  line  as  discussed  in  the  lemma.  Moreover,  when  the  region  R  considered  in  the 
above  lemma  is  split  as  described,  we  can  assume  (another  general  position  assumption)  that 
the  upper  virtual  wall  w,  is  not  perpendicular  to  6],  i.e.,  that  the  given  corner  which  causes 
the  splitting  is  not  at  distance  exactly  d  from  the  virtual  wall.  With  this  assumption  the  two 
maximal  noncritical  regions  whose  union  (together  with  the  common  free  boundary)  forms 
<P,(C)  are  associated  with  rwo  non-empty  cells  whose  upper  0-bound  is  8|. 

Corollary  2.11.  For  <  =  1  or  2,  if  $,((7)  has  nonempty  interior,  then  it  is  either  a  wit- 
ness region  for  6,  or  two  witness  regions  separated  by  the  line  on  which  the  criticality  of  6,  is 
manifested.  All  placements  in  its  interior  (or  more  precisely  where  the  elbow  is  in  its  inte- 
rior and  the  orientation  is  0,)  are  free  placements.  P 

Corollary  2.12.    For  (=0,1,2,  b,{C)CFP. 

Proof.  True  by  definition  for  <  =  0  and  follows  from  Corollary  2.11  for  the  other  two 
cases.  □ 

Lemma  2.13.  Every  placement  in  b0(C)Ubl(C)Ub2(C)  is  in  b(C),  and  the  rest  of 
b(C)  is  the  set  of  free  placements  of  the  form  (X,8,)  with  X€3(<i\(C))  for  i  =  1,2.  This 
remaining  set  of  placements  is  just  fc(<t\(C))  if  <t>,(C)  is  a  maximal  noncritical  region;  in  any 
case  it  is  a  finite  union  of  open  vertical  line-segments. 

Proof.  Consider  a  placement  (X,6)  with  0  i  [9,  ,6:]  and  Xtclosure{R*)  if  6*6,,  6;  and 
Xi<t>.(C)  if  6  =  0,.  Analogous  to  the  proof  of  Lemma  2.S,  if  e>0  is  the  distance  of  X  from 
the  boundary  of  R$  (or  of  *,(C),  as  appropriate),  there  exists  some  8>0  such  that 
B(  ,(X)  x  (0-5,6~6)nC  =  0:  thus  [X,Q)iclosure(C).  Therefore,  closure  (C)  is  confined  to 
closure  (<P,(C))x{Q  \-    for    i  =  l,2,    and    closure  (V?e)xW,    for    6<E(e,,0;).      It    is    evident, 
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therefore,  that  if  (X,6)  is  a  placement  in  b(C)  where  6  is  in  the  (open  angular)  range  of  C 
then  X$.b(RB),  and  if  it  is  in  b(C)  with  6  =  6,,  say,  then  clearly  either  (X,6)€£|(C)  or 
X((fPna(<t>,)).  This  essentially  concludes  the  proof:  it  is  straightforward  to  verify  that  the 
description  of  b[C)  ~  (b0(C)Ub[(C)Ub2(C))  is  correct.    □ 

Corollary  2.14.  The  placements  in  b(C)  ~  (bQ(C)Ubl(C)Ub2(C))  constitute  a  1- 
dimensional  subvanety  of  the  three-dimensional  manifold  FP,  and  their  removal  cannot 
disconnect  FP  nor  any  open  subset  of  FP. 

We  can  therefore  ignore  such  placements  in  the  motion-planning  problem.  The  proof 
of  the  above  corollary  follows  from  general  topological  considerations  (see  [SS1],[SS2]). 

Definition.    Two  cells  C  \  and  C2  are  adjacent  if  and  only  if 

(Mc.juMc^uMc,))  n  (b0(c2)ub,(c2)ub2(c2))    *    0. 

Some  of  the  nine  pairwise  intersections  are  always  empty:  we  proceed  to  establish  which  of 
them  can  be  nonempty. 

Lemma  2.15.    For  any  pair  of  distinct  cells  C,   and  C2,  (a)  b0(C , )ni> ,(C :)  =  0;  (b) 

*o(c,)n*2(c2)  =  0;  (c)  *,(c,)n*,(C2)  =  0;  (<»)  h(Ci)nh(Ci)  =  0- 

Proof.  In  the  following  discussion,  Rl6  denotes  the  set  of  placements  in  C,  at  orienta- 
tion 9.  (a)  If  (X,6)  t  A0(C,)ni>,(C:)  then  X  d  interior (<t»,(C:))  and  X  €  M*ie)-  But  this 
means  that  a  small  neighborhood  of  X  will  yield  a  point  in  common  between  interior  (<P\(C2)) 
and  &ie.  This  contradicts  the  fact  that  <J>,(C:)  should  witness  the  cnticality  of  9,  so  Rxi 
should  do  likewise  (if  <t>|(C;)  intersects  two  maximal  noncritical  regions,  then  both  of  them 
witness  the  criticality  of  8).  (b)  Essentially  the  same,  (c)  Let  (X,9)  be  in  the  intersection. 
Then  X  £  interior  (<t>  ,(C  ^(Mnterwr  (<t>i(C ;)).  Since  Rxi  and  R24  are  continuous  in  9,  there 
is  a  9'  slightly  greater  that  8  such  that  X  €  interior  (R  lB)H interior  {R  2*  )  and  9'  is  in  the 
range  of  both  cells.  But  this  implies  (X,6')  (.  C\DC2,  so  C\  =  C;.  (d)  Essentially  the  same 
as  (c).    c 
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Corollary  2.16.  Only  the  following  combinations  of  boundary  parts  yield  adjacencies 
between  two  distinct  cells  C  \  and  C;: 

(a)  t0(C1)nfc0(C:)  *  0,  i.e.,  there  exists  9  in  the  common  range  of  C,  and  C:  such  that 
b(RlB)nb(R2B)  *  0; 

(b)  bi(Ci)nb2(C2)  *  0,    i.e.,   interior  (<D,(C  ,))nJn/en'or  (*:(C;))  *  0   and   the   lower   9- 
bound  of  C\  coincides  with  the  upper  9-bound  of  C:;  or  (vice-versa) 

(c)  MC2)n&2(Ci)   *  0-  ie>  interior  (f^C:))  D  inferior  (<t>2(C  , ))   *  0. 

Lemma  2.17.  The  relation  o(/?i9)  n  fc(/?:e)  *  0  remains  invariant  for  all  6  in  the 
intersection  of  the  ranges  of  C  |  and  CV 

Proof.  (Sketch).  If  9  is  noncritical  for  both  cells  C(/?,e),  and  (X,9)  is  a  point  common 
to  their  free  boundary,  then  it  is  easy  to  show  that  X  is  in  a  unique  segment  7(9)  of  ne  line 
at  orientation  9  passing  through  a  fixed  (real  or  virtual)  corner  v  (see  Figure  3),  except  for 
the  situation  depicted  in  Figure  3d.  Thus  the  boundary  intersection  is  nonempty  whenever 
7(9)  is  defined  and  has  length  greater  than  d.  This  implies,  by  straightforward  continuity 
arguments,  that  the  set  of  orientations  9,  for  which  the  given  intersection  is  nonempty,  is 
open.  Let  0  represent  this  set  of  orientations.  Similarly,  if  9'  is  a  limit  orientation  of  such 
orientations  9,  and  9'  is  noncritical  for  either  cell,  then  7(9')  is  defined  and  has  length 
greater  than  d,  so  the  given  intersection  is  nonempty.  Thus  the  set  0  is  closed  (as  a  subset  of 
the  common  range  of  the  two  cells).  Thus  it  is  both  open  and  closed  within  the  common 
range.  Being  a  nonempty  subset  of  a  connected  range  of  orientations,  it  therefore  coincides 
with  that  range.    The  case  of  Figure  3d  can  be  handled  separately,    a 

Corollary  2.18.  CG$  is  invariant  between  critical  orientations.  To  be  more  precise,  if 
6!  and  9:  are  such  that  every  orientation  in  [9,,9:]  is  noncritical,  CG$,  is  naturally  iso- 
morphic to  CG  e-.  n 
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Definition.  The  three-dimensional  connectivity  graph  CG  is  the  graph  whose  vertices  are 
the  cells  of  FP  and  in  which  two  cells  C,  and  C:  are  adjacent  if  and  only  if  either 

(a)  *0(C,)nMC:)  *  0. 
(b)  b^C^Hb^^C^J  *  0.  or 

(c)  Mc2)nMCi)  *  0- 

Clearly  these  three  cases  are  mutually  exclusive. 

In  the  first  case  we  say  that  a  translational  adjacency  exists  between  C\  and  Ci,  in  the 
other  two  cases  the  adjacency  is  said  to  be  rotational.  The  terms  are  derived  from  the  fact  that 
a  translational  adjacency  allows  the  forearm  to  be  translated  from  one  cell  to  the  other  keep- 
ing the  orientation  (which  must  of  course  be  in  the  range  of  both  cells)  fixed,  as  in  the  two- 
dimensional  case.  A  rotational  adjacency  allows  the  forearm  to  cross  the  boundary  by  a  small 
rotation  without  moving  P.  The  definitions  are  illustrated  in  Figures  7  and  8.  The  preceding 
discussion  allows  us  to  state  the  following  result.  No  proof  is  given,  since  it  can  be  proved 
by  arguments  identical  to  those  in  Lemma  2.6. 


: 


l/9 


RM 


Figure  7. 


.      '■-:      : 
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Figure  S. 
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Lemma  2.19.  Z,  is  reachable  from  Z;  by  a  continuous  motion  in  FP  iff  C  (Z \)  is  reach- 
able from  C(Z2)  in  CC.  n 

Note.  By  Lemma  2.10,  if  <t>i(C)  has  nonempty  interior  R,  then  either  R  is  a  maximal 
noncritical  region  or  the  union  of  two  such  regions  with  the  free  boundary  separating  them. 
In  particular,  a  cell  can  be  adjacent  to  zero,  one,  or  two  other  cells  at  its  lower  (upper)  9- 
bound. 

The  above  results  allow  us  to  describe  fully  the  adjacencies  of  a  cell  C  |  in  CG  as  fol- 
lows: 

(1)  If  interior  (Q^C  i))  #  0,  two  cases  are  possible.  Let  9  be  the  critical  orientation 
defining  the  lower  9-bound  of  C , .  Let  /  be  the  line  with  orientation  9  which  manifests 
the  criticality  of  9,  so  /  f~l  <t>,  (C  ,)  *  0.  If  interior  (<t>  {(C  ,))  D  /  =  0,  interior  (<i>  ,(C  [)) 
is  a  maximal  noncritical  region  with  respect  to  9  (by  Lemma  2.10  assuming  the  obsta- 
cles are  in  general  position),  so  C  |  is  rotationally  adjacent  to  the  unique  cell  C2  for 
which  &|(C[)  C  fc;(Ci),  i.e.,  for  which  interior  (Q^C  {))  C  interior  (<$2(C2))  and 
whose  upper  9-bound  is  9  (by  Note  following  Lemma  2.19).  On  the  other  hand,  if  I 
cuts  interior (<P \(C ]))  into  two  regions,  then  C\  is  rotationally  adjacent  (at  9)  to 
C(/?|)  and  C(R2),  where  R,  are  those  two  maximal  noncritical  regions  which  intersect 
the  interior  of  <P\(C\).  (See  Note  following  Lemma  2.10,  which  justifies  the 
existence  of  these  two  cells.)    A  similar  analysis  holds  for  ^(C,). 

(2)  Consider  a  translational  adjacency  of  C,  and  C2  at  orientation  9;  thus 
fro(C1)n6o(C;)^0.  Moreover,  b  (R  ^)Db(R2^)*0,  so  R  ,„  is  adjacent  to  R2B  in 
CG$,  and  by  Corollary  2.18  /?(a  will  be  adjacent  to  R*  for  all  9'  in  the  common 
(angular)  range  of  C  j  and  C:.  Thus  all  translational  adjacencies  of  C  [  at  orientation  9 
are  valid  in  the  range  of  orientations  common  to  C]  and  all  its  •'translational  neigh- 
bors" at  9.  As  soon  as  one  of  the  neighbors,  say  C2,  disappears  by  virtue  of  9  leav- 
ing 9-range  of  C:,  the  corresponding  translational  adjacency  disappears,  possibly  to 
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be  replaced  by  an  adjacency  of  C,  to  a  new  cell  C3  whose  underlying  region  R2B  is 

adjacent  to  that  of  C ,  at  the  current  orientation. 
The  above  description  shows  that,  given  CG<>  for  every  noncritical  orientation,  it  is  possible 
to  build  Cx  by 

(1)  "opening"  it  at  its  lower  6-bound  9,  and,  if  <t> , (C , )  has  non-empty  interior,  creating 
one  or  two  rotational  links. 

(2)  adding  initial  0(1)  translational  adjacencies  from  CG^,-t,  for  sufficiently  small  e, 

(3)  updating   its    translational    adjacencies    according    to    CG$-t    after    each    criticality    6 
brought  about  by  creation  or  destruction  of  one  of  its  translational  neighbors, 

(4)  and  finally  "closing"  C  at  its  upper  8-bound  8],  creating  one  or  two  rotational  links  if 
<t>:(C))  has  non-empty  interior. 

The  preceding  paragraph  is  an  informal  description  of  the  progress  of  the  algorithm  for 
building  CG  when  restricted  to  its  effect  on  a  single  cell.  Note  that  knowledge  of  CG&  for 
every  noncritical  orientation  is  equivalent  by  Corollary  2.18  to  knowledge  of  CGS  for  each 
noncritical  interval  between  two  critical  orientations. 

3.    Algorithmic  details. 

The  connectivity  graph  is  constructed  following  the  model  of  the  Leven-Sharir  'ladder' 
algorithm.  Our  construction  differs  in  important  details  from  theirs  because  the  robot 
forearm  interacts  differently  with  real  and  virtual  walls.  The  construction  proceeds  to  first 
determine  all  the  critical  orientations,  then  compute  the  two-dimensional  connectivity  graph 
for  a  fixed  orientation,  and  finally  build  the  three-dimensional  connectivity  graph  incremen- 
tally from  the  two-dimensional  one  by  making  the  necessary  adjustments  in  connectivity  pat- 
terns as  the  orientation  crosses  each  criticalitv. 
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3.1.    Locating  all  critical  orientations. 

During  this  stage  we  process  each  corner  v  (whether  real  or  virtual)  and  determine  all 
critical  orientations  whose  witnesses  have  v  in  their  label.  The  following  lemma  shows  that 
this  is  sufficient  to  identify  all  the  criticalities. 

Lemma  3.1.  If  9  is  a  critical  orientation,  then  the  ambiguous  label  of  any  witness 
region  R  for  6  contains  at  least  one  corner. 

Proof.  Suppose  that  the  left  stop  of  R  is  ambiguous.  Let  Wfl  (cf.  Figure  9)  be  the  max- 
imal closed  segment  (at  orientation  9)  not  penetrating  obstacles  and  containing  thejeft  side 
of/?  (which  may  be  degenerate);  M  %  may  touch  obstacles  and  contain  walls.  Since  9  is  a  criti- 
cal orientation  and  R  is  a  witness  region,  the  following  condition  holds  twice  (independently): 
Mt  either  passes  through  a  corner  or  cuts  two  walls  at  points  exactly  d  apart.  Therefore,  A/9 
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Figure  9.  Generic  M B. 


has  to  (i)  pass  through  two  corners,  or  (ii)  pass  through  one  such  point  and  cut  two  walls  at 
points  d  apart,  or  (iii)  cut  through  two  pairs  of  walls  generating  two  pairs  of  points  each  pair 
exactly  d  apart. 

However,  (iii)  may  be  excluded  by  assumptions  of  general  position,  and  in  the  other 
two  cases  M%  contains  a  (real  or  virtual)  corner;  this  concludes  the  proof.  □ 

Fix  a  corner  v.  Note  that  all  criticalities  relevant  to  it  can  be  divided  into  three  classes: 

(1)  those  defined  by  another  corner  that  is  either  visible  from  v  or  on  a  common  wall 
with  v, 

(2)  those  that  are  defined  by  a  line  through  v  whose  intersections  with  two  walls  are 
exactly  d  units  apart,  and  v  does  not  meet  either  wall,  and 

(3)  those  defined  by  a  line  through  v  which  meets  another  real  wall  at  distance  d  from  v. 

The  following  computations  will  make  use  of  the  maximal  star-shaped  subset  A  of  the 
free  room  V  centered  at  v  and  a  similar  subset  B  of  the  workspace  F .  A  can  be  easily  com- 
puted from  V  by  a  sweeping  technique  in  time  O(nlogn),  while  B  can  be  computed  in  by  a 
linear  scan  of  (the  boundary  of)  F.  Both  A  and  B  will  be  represented  by  circular  lists  of  their 
boundary  edges. 

Let  us  consider  criticalities  of  each  class  separately. 

(1)  It  is  easy  to  compute  the  criticalities  of  the  first  type.  By  traversing  A,  find  the  list  of 
all  corners  visible  from  v  (those  are  the  vertices  of  A  that  are  corners)  including  the 
other  endpoints  of  walls  incident  to  v.  By  the  assumption  of  general  position,  no  three 
corners  are  on  the  same  line.  Using  brute  force,  compute  for  each  corner  w  on  the  list 
the  line-segment  M e  (where  9  is  the  orientation  of  vw:  it  is  potentially  a  critical  orienta- 
tion) and  the  set  of  virtual  walls  intersecting  W^.  The  amount  of  data  is  clearly  O(n) 
per  potential  criticality  6,  and  this  type  of  criticality  can  in  fact  have  complexity  O(n),  as 
illustrated  in  Figure  10.    Let  us  see  how  to  verify  that  9  is  indeed  a  criticality,  i.e.,  that 
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Figure  10. 

Me  contains  a  side  01  a  witness  region  R  for  0.  First  separate  Ma  into  its  intervals  of 
intersection  with  the  workspace  F  by  intersecting  it  with  all  the  virtual  walls  it  crosses 
(there  may  be  none).  Note  that  this  does  not  require  sorting  as  virtual  walls  are  natur- 
ally ordered  around  O.  For  each  segment  /  of  the  intersection  A/e  C\F,  construct  seg- 
ment J  by  extending  /  upwards  by  a  segment  of  length  d  and  clipping  if  necessary  to 
ensure  J  does  not  protrude  upwards  beyond  Af8.  In  order  for  /  to  be  the  side  of  a  wit- 
ness region  R  the  following  criteria  are  necessary  and  sufficient:  (i)  \J  \>d  (the  case 
\J  |  =  d  will  be  taken  care  of  in  (2)  and  (3)  below)  and  (ii)  both  v  and  w  be  in  the  clo- 
sure of  /.  These  criteria  can  be  verified  in  constant  time  per  segment  /,  and  therefore 
we  can  obtain  all  witness  regions  to  6  being  a  criticality  of  the  type  indicated  in  overall 
time  O(n)  per  potential  criticality  8.  Thus  we  can  compute  O(n)  criticalities  (per  corner 
v)  of  complexity  O(n)  in  time  0(n2),  yielding  a  total  of  0(n2)  O(n) -criticalities  com- 
puted in  0(n3)  time. 

(2)     We  will  now  turn  our  attention  to  the  criticalities  generated  by  a  line  passing  through  a 
corner  v  and  cutting  two  walls  a  distance  d  apart.    Consider  three  different  cases: 
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(i)  The  two  walls  in  question  are  real.    In  this  case  we  follow  the  procedure  of  [LS]  by 

merging  A  with  itself  shifted  by  it  and  then  examining  the  pair  of  real  walls 
corresponding  to  each  subinterval  produced  to  find  for  which  orientations  the  two 
are  exactly  d  apart.  At  such  orientations  the  line-segment  MB  has  length  d.  To  ver- 
ifv  that  it  witnesses  a  critical  orientation  one  must  check  only  that  its  lower  end  is  in 
the  closure  of  the  workspace  F . 

(ii)  The  lower  of  the  two  walls  is  virtual  and  the  upper  is  real:  no  other  combination 

involving  a  virtual  wall  leads  to  a  criticality.  First  we  derive  those  criticalities  where 
the  real  and  virtual  walls  are  on  the  same  side  of  v.  Consider  the  cyclically  ordered 
list  A  of  visible  real-wall  segments  around  v  and  compare  it  to  the  boundary  of  the 
maximal  star-shaped  subset  B  of  F  centered  at  v.  By  a  merging  operation  one  can 
determine  all  orientations  6  such  that  the  ray  at  orientation  9  from  v  meets  such  a 
virtual  wall  w  i  on  B  and  at  distance  d  beyond  it  a  real  wall  w:  (in  A).  These  orien- 
tations are  the  critical  orientations  of  the  kind  we  expect.  Note  that  there  are  0(n2) 
such  orientat.ons  for  each  v  and  each  has  complexity  0(1). 

(iii)  Next  we  cover  the  subcase  where  the  real  and  virtual  walls  are  on  opposite  sides  of 

v.  Consider  a  triangular  sector  of  A  defined  by  v  and  an  edge  of  A.  Using  brute 
force,  in  linear  time  compute  the  intersections  of  this  sector  with  all  virtual  walls. 
Combining  this  information  with  the  list  of  edges  of  A  shifted  by  tt,  determine  all 
orientations  0  such  that  the  line-segment  vX  C  V  in  direction  9  connecting  v  to  a  real 
wall  has  length  a  <  d  and  the  line  in  direction  0  +  -rr  meets  a  virtual  wall  at  a  point  Y 
such  that  the  line  segments  vY  has  length  d  -  a.  This  can  be  done  by  simultaneously 
sweeping  through  the  lists  described  above,  yielding  0(n2)  pairs  of  such  points  X 
and  Y  and  thus  computing  another  class  of  0(n2)  criticalities  of  complexity  0(1)  in 
time  0(n:).    This  bound  is  tight  as  illustrated  by  Figure  11. 
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Figure  11. 

(3)  Similar  to  (2iii).  Identify  each  direction  9  where  a  nearest  real  wall  is  met  at  a  distance 
d  form  v;  a  brute-force  search  through  the  virtual  walls  that  are  cut  by  a  ray  from  v  with 
orientation  6  +  ir  gives  the  desired  witness  region  (the  real  wall  at  which  the  said  ray 
leaves  V  is  one  of  the  candidates  for  the  search). 


3.2.    Construction  of  CC,  for  a  noncritical  orientation  6. 

Let  8  be  a  particular  noncritical  orientation  (again  visualized  as  directed  vertically 
upwards).  Given  the  boundaries  of  the  surrounding  room  and  enclosed  obstacles,  it  is 
required  to  partition  the  interior  of  the  room  outside  the  obstacles  into  maximal  noncritical 
regions  with  respect  to  8  and  to  compute  the  adjacency  relation  on  the  regions  explicitly.    Let 


VP  denote  the  free  room  V  partitioned  by  vertical  line-segments  (i.e.,  line-segments  at  orien- 
tation 0)  through  the  corners  of  V:  a  vertical  segment  through  a  corner  extends  up  to  the 
walls  directly  above  and  below  it.  (Since  9  is  assumed  noncritical,  these  line-segments  can  be 
characterized  more  precisely  as  follows:  for  each  corner  v  its  corresponding  line-segment  is 
the  maximal  vertical  interval  containing  v  in  the  closure  of  V.)  It  is  easy  to  construct  VP 
naively  in  time  0(n2).  The  regions  in  VP  are  triangular  or  trapezoidal  in  shape.  Each  such 
region  is  then  pruned  by  taking  a  line  parallel  to  its  upper  segment,  at  distance  d  below  it, 
and  discarding  that  part  of  the  region  on  or  above  this  line  (this  may  delete  the  whole 
region).  Each  remaining  nonempty  region  R  is  a  maximal  noncritical  region  in  the  sense  of 
[LS];  any  vertical  placement  of  the  ladder  with  P  in  R  is  a  free  placement  and  the  vertical 
ends  of  R  represent  either  nonfree  placements  or  a  change  ;n  upper/lower  stop.  We  can 
regard  these  regions  as  nodes  in  a  graph  G  whose  edges  connect  adjacent  regions  with  non- 
trivial  common  (vertical)  boundary. 

Next  compute  the  set  VTV  of  virtual  walls.  This  can  be  done  naively  in  0(nz)  time,  say, 
by  sorting  the  corners  of  V  in  cyclic  order  around  0  and,  rotating  a  sweepline  around  O, 
computing  the  subsegments  of  real  walls  visible  from  0.  The  virtual  walls  then  are  whatever 
radial  edges  are  needed  to  connect  these  real  wall-segments  into  the  visibility  polygon  around 
O.  This  yields  O(n)  virtual  walls.  Note  that  since  each  open  triangular  or  trapezoidal  region 
T  of  VP  contains  no  wall,  it  contains  no  endpoint  of  any  virtual  wall.  Assuming  that  VW  is 
sorted  cyclically  around  O,  the  set  of  virtual  walls  intersecting  the  interior  of  such  a  tra- 
pezoidal region  T  can  be  identified  in  O(n)  time,  in  cyclic  order  around  O:  these  intersecting 
walls  partition  T  radially  into  several  strips,  alternately  inside  and  outside  the  workspace  F . 

Let  U  be  such  a  strip.  Being  the  intersection  of  T  with  a  wedge  whose  apex  is  at  O,  U  is 
bounded  by  at  most  two  virtual  walls,  and  therefore  has  between  four  and  six  sides.  Also,  U 
has  at  most  two  corners  where  a  virtual  wall  meets  one  of  the  non-vertical  sides  of  7":  in  other 
words,    U  possesses    at   most  two  corners  which   are  virtual  corners   of  F.     Vertical   lines 
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through  these  corners  partition  U  into  at  most  three  open  trapezoidal  regions,  and  by  defini- 
tion, the  upper  and  lower  segments  bounding  each  such  regions  contain  no  real  or  virtual 
corner.  Therefore  each  such  region  is  entirely  contained  in  some  maximal  noncritical  region 
of  CG$.  There  are  0(n2)  such  regions.  We  can  regard  these  regions  as  being  nodes  in  a 
graph  C  whose  edges  connect  adjacent  regions  possessing  a  nontrivial  common  vertical 
boundary.  Then  C  can  be  regarded  as  a  size  0(n2)  subdivision  of  CG$,  and  it  can  have 
been  constructed  in  0(nz)  time  overall.    This  bound  is  tight  as  illustrated  in  Figure  5. 

Finally  the  graph  G'  may  contain  chains  of  contiguous  regions  all  possessing  the  same 
upper  and  lower  stops  (this  can  arise  where  vertices  separating  maximal  noncritical  regions  in 
the  sense  of  [LSJ  are  occluded  by  some  vertical  wall).  It  is  easy  to  merge  such  chains  of  ver- 
tices together,  and  in  this  way  the  desired  connectivity  graph  CG$  is  constructed.  The  pro- 
cedure for  computing  CG$  is  illustrated  in  Figure  12. 

3.3.    Incremental  construction  of  CG  froT  CGt. 

This  section  describes  the  final  step  >f  the  algorithm  —  the  construction  of  the  connec- 
tivity graph  CG  which  defines  the  partition  of  :he  space  of  all  free  placements  FP  into  cells 
together  with  the  connectivity  pattern  among  them.  The  reachability  problem  is  then  reduced 
to  identifying  the  cells  where  the  initial  and  final  placements  are  located  and  then  determining 
whether  the  two  are  connected  by  at  least  one  path  in  the  graph  CG.  The  algorithm  is  easily 
modified  to  create  a  path  between  starting  and  destination  placements  with  no  performance 
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degradation,  as  a  path  connecting  arbitrary  points  of  two  adjacent  cells  can  be  computed  in 
constant  time. 

Again,  our  presentation  follows  [LS]  with  modifications  necessary  to  take  virtual  walls 
into  account.  We  will  assume  that  a  sorted  list  of  all  0(ni)  critical  orientations  is  available. 
It  can  be  compiled  by  sorting  in  time  0(n3logn).  It  is  also  assumed  that  each  critical  orienta- 
tion carries  with  it  the  information  on  how  it  was  created.  This  includes  the  label  of  the  criti- 
cal orientation,  the  corner  that  the  line  with  such  an  orientation  has  to  pass  through  to  exhibit 
its  criticality,  the  other  corner  (if  any)  through  which  it  passes,  the  real  walls  at  which  it  ter- 
minates, and  the  virtual  walls  bounding  witness  regions  which  it  meets. 

The  construction  begins  by  choosing  a  noncritical  orientation  0O  and  building  the  graph 
CGq0  in  time  0(nz)  as  described  above.  There  are  two  structures  maintained  throughout  the 
construction:  CG$,  the  two-dimensional  connectivity  graph  with  respect  to  the  current  orien- 
tation 8,  and  an  incomplete  version  of  CG,  which  includes  cells  with  orientation  ranges  trun- 
cated to  within  [90 , 0]  and  adjacency  relation  restricted  to  those  cells.  Set  the  current  orienta- 
tion 6  to  be  0O  Initialize  CG  by  copying  CG^r,  and  modifying  each  node  R  (which  is  a  maxi- 
mal noncritical  region  with  respect  to  80)  to  represent  instead  a  cell  with  R  as  its  underlying 
region  Rit  80  as  lower  8-bound,  and  a  special  "unknown"  value  as  the  upper  8-bound.  This 
will  take  0(n:)  time,  as  a  copy  of  CG»Q  needs  to  be  made. 

As  we  have  already  noted  the  connectivity  structure  of  CGq  only  changes  when  8 
crosses  a  criticality  (Corollary  2.18).  When  8  crosses  a  criticality  only  the  witness  regions  of 
the  criticality  and  their  neighbors  will  be  affected,  and  because  CGp,  has  bounded  degree 
(assuming  the  obstacles  are  in  general  position,  so,  for  example,  each  region  in  CG g  for  a 
noncritical  8  shares  its  free  left  boundary  with  at  most  two  other  regions),  this  means  that 
O(k)  work  is  needed  to  process  the  graph  when  crossing  a  criticality  of  complexity  k.  The 
changes  needed  can  easily  be  determined  by  examining  the  description  of  the  criticality  alone 
(see  Figure  13). 
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<t>;(C2)  =  <t>1(C5) 


R ;  =  interior(<t>  ,(C  ,))=  interior^  .(C 4)) 
/?,=  inter  ior(<&\(C\))=  interior^  t(C  6)) 

Figure  13. 

Let  us  describe  some  of  the  details  of  how  the  graph  CG  is  built  in  this  way.  At  each 
critical  orientation  6',  for  each  region  R  being  destroyed  in  CG$  _t  (i.e,  for  each  R  such  that 
the  upper  9-bound  of  C  (R)  is  6';  e  is  chosen  so  there  are  no  criticalities  between  9'-e  and 
6'),  make  6'  the  upper  9-bound  of  the  corresponding  "unfinished"  cell  in  CG,  and  for  each 
R  being  introduced  into  CGe  -t  create  a  new  cell  in  CG  based  on  R  with  6'  as  its  lower  9- 
bound  and  unknown  upper  0-bound  w  h  all  translational  adjacencies  inherited  from  R. 
When  a  region  in  CG9  is  destroyed,  it  either  contracts  to  a  set  with  empty  interior,  or 
becomes  one  or  two  (adjacent)  maximurr  noncritical  regions  with  respect  to  6'  with  ambigu- 
ous labels  (Lemma  2.10).  The  latter  type  f  <t>:  creates  a  rotational  adjacency  per  noncritical 
region  with  respect  to  9'  contained  in  <t»;  (see  Figure  8),  for  a  total  of  at  most  two  per  cell 
per  9-bound.  At  this  point  all  new  rotational  links  associated  with  9'  are  added.  After  pro- 
cessing is  completed  we  have  a  'split'  connectivity  graph  whose  range  is  [90,90^2ir]:  we  can 
assume  that  the  structure  of  CG$0  has  been  saved,  and  the  processing  has  yielded  (as  a  by- 
product) a  connectivity  graph  CG*  -:-  which  is  of  course  naturally  isomorphic  to  the  former 
graph.    At  this  point  we  have  to  "repair"  the  cells  split  in  two  by  90- 

For  simplicity  let  us  assume  that  the  lines  joining  all  pairs  of  corners  in  the  workspace  F 
have  slopes  different  from  90:  these  slopes  were  generated  when  locating  criticalities,  so  this 
causes  no  problems  (some  but  not  necessarily  all  of  these  slopes  are  indeed  critical  orienta- 
tions). Let  G  abbreviate  the  initial  translation  graph  CG*,)  and  G'  the  final  translation  graph 
CGtn-2--     As   remarked,   G   and   G'    match   exactly.     Each   node    in   these   graphs   may   be 
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assumed  labeled  with  its  four  stops.  Again  visualizing  the  direction  60  as  vertical,  let  V  and 
V  be  the  node-sets  in  each  graph  —  suitably  represented,  and  including  the  coordinates  posi- 
tion of  their  lower  left  corners;  sort  the  combined  set  according  to  the  y-coordinates  within 
x-coordinates  of  their  lower  left  corners.  Then  corresponding  nodes  in  each  graph  will  be 
adjacent  in  the  resulting  sorted  list.  Thus  the  nodes  can  be  matched  up,  and  the  correspond- 
ing half-cells  merged.    The  overall  work  for  this  phase  is  O(n2\og(n)). 

Thus  CG  has  been  computed.  To  solve  a  given  motion-planning  query,  specified  by  ini- 
tial and  final  placements  Z0  and  Zj,  it  is  enough  to  compute  the  labels  of  C{Z0)  and  C(Z{) 
and  locate  the  corresponding  cells  in  CG,  perhaps  by  a  linear  scan  of  its  cells.  The  problem 
can  then  be  solved  by  a  straightforward  search  of  CG.  This  concludes  our  description  of  the 
final  stage  of  the  0(n3logn)  algorithm  that  reduces  path  planning  for  a  specific  model  of  a 
two-dimensional  robot  to  searching  of  a  graph  of  size  0(n3). 

4.    Concluding  remarks. 

We  have  presented  an  exact  algorithm  to  solve  motion-planning  problems  for  an  ideal- 
ized two-link  planar  robot  arm.  The  main  effort  has  been  to  analyze  the  configuration  space 
of  such  an  arm:  in  contrast  with  the  related  'ladder  mover's'  problem  studied  in  the  litera- 
ture, the  configuration  space  complexity  is  0(«3).  Our  algorithm  computes  it  with  a  small 
extra  overhead  of  log(n).    The  analysis  leaves  some  interesting  questions  open: 

How  realistic  is  the  model?  It  seems  to  us  that  the  most  unrealistic  assumption  is  that 
of  the  infinite  extensibility  of  the  'upper  arm.'  Minimal  and  maximal  radii  should  probably 
be  prescribed  for  the  length  of  this  link.  It  does  not  seem  too  difficult  to  incorporate  this 
restriction  into  the  algorithm:  the  effect  is  to  confine  the  workspace  in  an  annular  planar 
region,  so  the  only  variant,  essentially,  is  accommodating  circular  arcs  in  the  description  of 
the  workspace.  Similarly,  limiting  the  range  of  angles  through  which  the  upper  arm  can 
rotate  about  the  shoulder  obviously  causes  no  difficulty:  everything  is  confined  between  two 
extra  virtual  walls.    To  limit  the  range  of  rotation  at  the  elbow  is  easy  if  the  range  of  rotation 
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is  absolute,  i.e.,  related  to  the  plane  rather  than  the  mutual  angle  between  the  two  links  at 
the  elbow,  since  that  would  only  involve  setting  limits  on  the  angular  range  of  the  graph  CG. 
To  incorporate  relative  angular  restraints  at  the  elbow  is  a  different  matter  and  it  is  not  clear 
that  the  method  of  this  paper  is  appropriate  for  such  a  situation.  Another  variation  of  the 
problem  would  be  to  model  the  upper  arm  not  as  a  telescoping  link  but  a  fixed-length  sliding 
boom  (cf.  Fortune,  Wilfong  and  Yap  [FWY]).  This  variation  may  be  amenable  to  the 
methods  discussed  here. 

It  is  not  clear  whether  our  method  generates  'efficient'  solutions  to  the  motion-planning 
problem,  i.e.,  solution  paths  formed  from  sufficiently  few  'primitive  path-segments'  (such  as 
translations  between  adjacent  cells).  It  is  possible,  but  seems  unlikely,  that  nonlinear  lower 
bounds  such  as  Ke  and  O'Rourke's  [KO]  can  be  shown  to  hold  here:  indeed,  we  conjecture 
that  while  the  number  of  components  of  configuration  space  can  be  fl(«3),  any  two  mutually 
accessible  placements  can  be  connected  by  a  path  of  descriptive  complexity  0{n).  It  would 
seem  that  the  constraint  imposed  by  the  upper  arm  can  both  subdivide  (which  we  know)  con- 
figuration space  but  yet  produce  simpler  components:  for  instance,  every  such  component  is 
of  course  simply  connected. 
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